#include "motor.h"

int main(int argc, char** argv)
{
    float speed1 =25;
    float speed2 =0;
    float speed3 =40;
    Motor * m = new Motor();
    //m->setSpeed(false, speed);
    //m->rotate(true, speed);
    //wait(1);
    m->setSpeed(true, speed1);
     sleep(1);

    m->rotate(false,speed1);
    sleep(1);

     m->setSpeed(true, speed1);
     sleep(1);

    m->rotate(true,speed1);
    sleep(1);

     m->drive_individual(true, speed1, speed2);
       sleep(1);

    m->setSpeed(true,speed2);
  //  m->drive_right(true, speed2);
    return 0;
}
